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A CONTROL SYSTEM FOR A POWERED VEHICLE 

Technical field of the invention 

The present invention relates in a first aspect to a control system for a 
powered vehicle. 

In a second aspect the present invention relates to a method of controlling 
a movement of a powered vehicle. 

In a third aspect the present invention relates to at least one computer 
program product for controlling a movement of a powered vehicle. 



Description of related art 

The theatre has automated much of the equipment used for movement of 
scenery and lighting. Most of stage activity involves simply moving scenery about 
the stage. Automated systems for doing this have been limited by poor radio com- 

15 munication, lack of accuracy and navigation, high noise and high costs. 

The document U.S. Patent No. 5,823,884 discloses a powered stage 
wagon comprising a chassis to which there is mounted a plurality of rolling support 
means, each of which is located at respective corner of the chassis. The powered 
stage wagon also comprises a first and a second drive means, both mounted on 

20 the chassis in engagement with the surface over which the stage wagon is to 

move and are mutually spaced. The document describes a method of calculating a 
travel path along which the stage wagon may be moved from a current position to 
a desired position. The method comprising the steps of calculating for each of said 
drive means the bisector of a line joining the current location of said drive means 

25 and the location of said drive means when the stage wagon has moved to its de- 
sired position; determining the point of intersection of the two bisectors; calculating 
for each of said drive means the length of an arc centred on said point of inter- 
section and passing through both the current location of said drive means and the 
location of said drive means when the stage wagon has moved to its desired posi- 

30 tion; controlling the ratio of the rotational speeds of the first and second drive 

means in accordance with the ratio of said arc lengths; and controlling the relative 
orientation of said first and second drive means so that each of said drive means 
continuously defines a tangent to the respective arc associated with the drive 
means concerned. 
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One main disadvantage with the method of calculating a travel path ac- 
cording to the document US-5, 823,884 is that it limits paths to certain predefined 
combinations of translation and rotation. Another disadvantage is that the method 
does not correct for any physical errors in movement that might occur. 

5 

Summary of the invention 

It is an object of the present invention to solve the above mentioned prob- 
lems. 

According to the present invention there is provided in a first aspect a con- 

10 trol system for a powered vehicle for describing a desired movement of said vehi- 
cle, and communicating said movement to a drive system of said vehicle. The 
powered vehicle comprising a chassis, at least three rolling means mounted on 
said chassis for engagement with a surface over which said vehicle is to move. 
The drive system comprises at least two drive units, each comprising a first driving 

15 means and a second driving means, co-operatively operable to provide both pro- 
pulsion and steering of said drive unit and consequently said vehicle. The control 
system also comprises a computing means for calculating a desired movement of 
said vehicle, wherein translation of said vehicle is calculated in said form of a con- 
tinuous cubic function , and rotation of said vehicle is calculated in the form of a 

20 linear function. The control system also comprises a communicating means for 
transmitting said desired movement to said desired movement to said at least two 
drive units to move said vehicle in accordance with the desired movement. One 
advantage with the control system according to the present invention is that it can 
move a vehicle along any predefined path, with a predefined change in rotation in 

25 accordance with a time scale. Another advantage with this control system is that it 
is scalable, i.e. it can move any number of vehicles simultaneously along different 
paths. Another advantage with this control system is that it allows vehicles to move 
in any direction. It makes no assumptions as to one direction being more natural 
than another. Yet another advantage with this control system is that it uses the 

30 same method of describing any type of movement or path. 

A further advantage in his context if said control system also comprises a 
navigation system for determining an actual position of said vehicle, which actual 
position is transmitted to said computing means for correcting errors between the 
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actual position and a desired position according to said desired movement of said 
vehicle. 

Furthermore, it is an advantage in this context if said continuous cubic 
function is a Bezier function of a third power. 
5 A further advantage in his context if Bezier function is expressed in accor- 

dance with: 

x = ap 3 + bp 2 + cp + d 
y = ep 3 + fp 2 + gp + h , 

wherein a - h are constants and p is a variable satisfying 0 < p < 1 . 
10 Furthermore, it is an advantage in this context if said computing means calculates 
said constants a - h according to the following expressions: 
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20 wherein (X 0 , yo) is a start position and (x 3 , y 3 ) is an end position of said move- 
ment, and (xi , y0 and (x 2 , yz) are control positions of said movement. 

A further advantage in his context if said movement is made up of at least 
one segment. 

Furthermore, it is an advantage in this context if if said movement is made 
25 up of at least two segments, said control system has to apply to the following rules 
if said vehicle is to move smoothly from one segment to the next: 

- a start position of the following segment must be the same as an end position of 
the preceding segment; 

- a start rotation of the following segment must be the same as an end rotation of 
30 the preceding segment; 

- a starting path of the following segment must be tangent to an end path of the 
preceding segment; and 

- a starting speed and direction of rotation of the following segment must be the 
same as an end speed and direction of rotation of the preceding segment. 
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A further advantage in his context if said computing means also calculates 
an instantaneous center of said vehicle. 

Another object of the invention is to provide a method of controlling, with 
the aid of a control system, a movement of a powered vehicle. The vehicle com- 
5 prises a chassis, a drive system, at least three rolling means mounted on said 
chassis for engagement with a surface over which said vehicle is to move. The 
drive system comprises at least two drive units, each comprising a first driving 
means and a second driving means, co-operatively operable to provide both pro- 
pulsion and steering of said drive unit. The method comprises the following steps: 
10 - with a computing means comprised in said control system, to calculate a 

desired movement of aid vehicle; 

- by calculating a translation of said vehicle in the form of a continuos cu- 
bic function; and 

- by calculating a rotation of said vehicle in the form of a linear function; 

15 and 

- with a communication means comprised in said control system, to trans- 
mit said desired movement to said at least two drive units to move said vehicle in 
accordance with said desired movement. One advantage with the method accord- 
ing to the present invention is that it can move a vehicle along any predefined 

20 path, with a predefined change in rotation in accordance with a time scale. Another 
advantage with this method is that it is scalable, i.e. it can move any number of 
vehicles simultaneously along different paths. Another advantage with this method 
is that it allows vehicles to move in any direction. It makes no assumptions as to 
one direction being more natural than another. Yet another advantage with this 

25 method is that is uses the same method of describing any type of movement or 
path. 

A further advantage in this context is achieved if said method also com- 
prises the steps of: 

- with a navigation system comprised in said control system, to determine an ac- 
30 tual position of said vehicle; 

- to transmit said actual position to said computing means; and 

- to correct errors between said actual position and a desired position according 
to said desired movement of said vehicle. 
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Furthermore, it is an advantage in this context if said continuous cubic 
function is a Bezier function of a third power. 

A further advantage in this context is achieved if said Bezier function is 
expressed in accordance with: 
5 x = ap 3 + bp 2 + cp + d 
y = ep 3 + fp 2 + gp + h , 

wherein a - h are constants, and p is a variable satisfying 0 < p < 1 . 

Furthermore, it is an advantage in this context if said method also com- 
prises the steps of 

10 - to calculate said constants a - h according to the following expressions: 

a = x 3 - 3x 2 + 3xi - x 0 

e = y 3 - 3y 2 + 3yi - y 0 

b = 3x 2 - 6x1 + 3x 0 

f = 3y 2 - 6yi + 3y 0 
15 c = 3x! - 3x 0 

g = 3yi - 3y 0 

d = x 0 

h = y 0 , 

wherein (X 0 , yo) is a start position and (x 3 , y 3 ) is an end position of said move- 4 
20 ment, and wherein (xi , yi) and (x 2 , y 2 ) are control positions of said movement. 

A further advantage in this context is achieved if said method also com- 
prises the steps of: 

- to calculate an instantaneous center and angular velocity of said vehicle; and 

- to calculate speeds and angles of said drive unit. 

25 Furthermore, it is an advantage in this context if said method also com- 

prises the steps of: 

- if said error will result in abrupt movement of said vehicle, to integrate succeed- 
ing corrections; and 

- to add a suitable proportion of said corrections for each time slice. 

30 Another object of the invention is to provide at least one computer pro- 

gram product directly loadable into the internal memory of at least one digital com- 
puter. The at least one computer program product comprises software code por- 
tions for performing the steps of the method according to the present invention, 
when said at least one product is/are run on at least one computer. One advan- 
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tage with the computer program product(s) according to the present invention is 
that it/they can move a vehicle along any predefined path, with a predefined 
change in rotation in accordance with a time scale. Another advantage with this 
product is that it is scalable, i.e. it can move any number of vehicles simultane- 
5 ously along different paths. Another advantage with this product is that it allows 
vehicles to move in any direction. It makes no assumptions as to one direction be- 
ing more natural than another. Yet another advantage with this product is that is 
uses the same method of describing any type of movement or path. 

It should be emphasised that the term "comprises/comprising" when used 
10 in this specification is taken to specify the presence of stated features, steps or 
components but does not preclude the presence of one or more other features, in- 
tegers, steps, components or groups thereof. 

Brief description of the drawings 

15 Embodiments of the invention will now be described with a reference to 

the accompanying drawings, in which: 

Figure 1 shows a block diagram of a first embodiment of a control system for 
a powered vehicle according to the present invention; 

Figure 2 shows a side view from above of a drive unit that can be used in 
20 connection with the present invention; 

Figure 3 shows a schematic diagram of a powered vehicle that can be used in 
connection with the present invention; 

Figure 4 is a flowchart of a first embodiment of the method of controlling a 
movement of a powered vehicle according to the present invention; and 
25 Figure 5 shows a schematic diagram of some computer program products ac- 
cording to the present invention. 

Detailed description of embodiments 

Figure 1 shows a block diagram of a control system 70 for a powered ve- 
30 hide 72 according to the present invention. The powered vehicle 72 comprises a 
drive system (not disclosed, see figure 3), a chassis (not disclosed), at least three 
rolling means (not disclosed) mounted on said chassis for engagement with a sur- 
face over which said vehicle is to move. The drive system comprises at least two 
drive units (see figure 2), each comprising a first driving means and a second driv- 
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ing means, co-operatively operable to provide both propulsion and steering of said 
drive units. The control system 70 comprises a computing means 74 for calculat- 
ing a desired movement of said vehicle 72, wherein translation of said vehicle 72 
is calculated in the form of a continuous cubic function, and rotation of said vehicle 
5 72 is calculated in the form of a linear function. The control system 70 also com- 
prises a communication means 76 for transmitting said desired movement to said 
at least two drive units to move said vehicle 72 in accordance with the desired 
movement. The control system 70 also comprises a navigation system 78 com- 
prised in said vehicle 72 for determining an actual position of said vehicle, which 
10 actual position is transmitted to the computing means 74 via said communication 
means 76 for correcting errors between the actual position and a desired position 
according to said desired movement of said vehicle 72. 

In a preferred embodiment of the control system 70 according to the pre- 
sent invention the continuos cubic function is a Bezier function of a third power. 
15 In a preferred embodiment of the controlsystem 70 according the present 

invention the Bezier function is expressed in accordance with: 
x = ap 3 + bp 2 + cp + d 
y = ep 3 +fp 2 +gp + h, 

wherein a-h are constants and p is a variable satisfying 0 < p < 1 . 
20 In a preferred embodiment of the control system 70 according to the pre- 

sent invention the constants a-h are calculated in accordance with the following 
expressions: 





a = X3-3x 2 + 3xi-X 0 




e= y3-3y 2 + 3yi-y 0 


25 


b = 3x 2 - 6xi + 3xo 




f = 3y 2 - 6y-i + 3y 0 




c = 3x^ -3xo 




g = 3y^- 3y 0 




d = Xo 


30 


h = y 0 



wherein (xo, yo) is a start position and (y3, y3) is an end position of said 
movement, and (x 1f y^ and ((x 2 , y 2 ) are control positions of said movement. 

In a preferred embodiment of the control system 70 according to the pre- 
sent invention the movement is made up of at least one segment. 
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In a preferred embodiment of the control system 70 according to the pre- 
sent invention, if said movement is made up of at least two segments, the control 
system 70 has to apply the following rules if said vehicle 72 is to move smoothly 
from one segment to the next: 
5 - a start position of the following segment must be the same as an end po- 

sition of the preceding segment; 

- a start rotation of the following segment must be the same as an end ro- 
tation of the preceding segment; 

- a starting path of the following segment must be tangent to an end path 
10 of the preceding segment; and 

- a starting speed and direction of rotation of the following segment must 
be the same as an end sped and direction of rotation of the preceding segment. 

In a preferred embodiment of the control system 70 according to the pre- 
sent invention, the computing means 74 also calculates an instant aneous center 

15 of said vehicle 72. The movement of any point on the vehicle 72 can always be 
described as a rotation about the instantaneous center is calculated errors in the 
vehicles position along the curve and its rotation as reported by the navigation sys- 
tem 78 may be accounted for. 

Figure 2 shows a side view from above of a drive unit 10 which can be 

20 used in connection with the present invention. 

The drive unit 10 comprises a rolling means 12 intended to be in frictional 
engagement with a surface over which said drive unit 10 is intended to move. 
Preferably, said rolling means 12 is a wheel 12. The drive unit 10 also comprises a 
first driving means 14, and a second driving means 16, co-operatively operable to 

25 provide both propulsion and steering of said drive unit 10. The first driving means 
14 is arranged on a rotatable support means 18 rotatable about a center axis, c.a. 
The first driving means 14 is operable to rotate said rolling means 12 about a roll- 
ing axis. The rolling axis is perpendicular to said center axis, c.a. As is apparent 
from fig. 2, the rolling means 12 is displaced a predetermined distance from the 

30 center axis, c.a. The second driving means 16 is operable to rotate the support 
means 18 about said center axis, c.a. In one preferred embodiment of the drive 
unit 10, which is disclosed in fig. 1 , the first and second driving means 14, 16, 
each is a servomotor 14, 16. The drive unit 10 also comprises a sprocket means 
20 provided on the circumference of the support means 18. The sprocket means 
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20 is driven by the second driving means 16 by way of a transmission means. In 
the embodiment disclosed in fig. 2, the transmission means is a chain 22 which is 
engaged with said sprocket means 20 and a toothed wheel 24 driven by said sec- 
ond driving means 16. The drive unit 10 disclosed in fig. 2 also comprises a ten- 

5 sion wheel 26 which can be in engagement with the chain 22. The tension wheel 
26 can be moved along a groove 28 so as to alter the tension on the chain 22. The 
drive unit 10 also comprises an inductive sensor 30 arranged in a sensor holder 32 
to detect the position of the sprocket means 20, i.e. the orientation of the wheel 12. 
The drive unit 10 also comprises a rotation limiter 34 arranged in the vicinity of the 

10 sprocket means 20. Preferably, the drive unit 10 also comprises a planetary 

gear-box (not disclosed) mounted on the first driving means 14, and in connection 
with the wheel 12. The rotatable support means 18 is supported by a ball bearing 
means (not disclosed). The support means 18 is preferably a plate 18. 

Figure 3 shows a schematic diagram of a powered vehicle 50;72 which 

15 can be used in connection with the present invention. 

This vehicle 50 comprises two drive units 10, of the same kind disclosed in 
fig. 2, and two passive rolling means 52. The two drive units 10 are arranged in 
two diagonally arranged corners of the vehicle and the two passive rolling means 
52 are arrange in the two other corners of the vehicle. The vehicle 50 is e.g. pow- 

20 ered by a battery pack 54. The vehicle 50 also comprises a wireless communica- 
tion means 56 for communicating with a remote computer system 58 to control 
said drive unit 10, i.e. the movement and steering of the vehicle 50. The vehicle 50 
also comprises a laser navigation unit 60, e.g. a laser scanner which makes use of 
several reflectors mounted along the perimeter of e.g. the stage area. The vehicle 

25 50 also comprises a central processing unit 62 which is connected to the laser 
navigation unit 60, the wireless communication means 56, the battery pack 54 and 
a number of servo amplifiers 64 which in turn are connected to the drive units 10. 

In figure 4 there is a flowchart of a first embodiment of the method of con- 
trolling a movement of a powered vehicle according to the present invention. The 

30 method begins at block 80. The vehicle comprises a chassis, a drive system, at 
least three rolling means mounted on said chassis for engagement with a surface 
over which said vehicle is to move. The drive system comprises at least two drive 
units, each comprising a first driving means and a second driving means, co- 
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operatively operable to provide both propulsion and steering of said drive units. At 
block 82 the method continues with the step: 

with a computing means comprised in said control system, to calculate a 
desired movement of said vehicle. The method continues at block 84, to calculate 
5 a translation of said vehicle in the form of a continuos cubic function The next step, 
at block 86, consists of calculating a rotation of said vehicle in the form of a linear 
function. 

The method continues at block 88 with the step: with a communication 
means comprised in the control system, to transmit said desired movement to said 
10 at last two drive units to move said vehicle in accordance with said desired move- 
ment. The method is completed at block 90. 

In a preferred embodiment of the method according to the present inven- 
tion, the method also comprises the steps of: 

- with a navigation system comprised in said control system, to determine 
is an actual position of said vehicle; 

- to transmit said actual position to said computing means; and 

- to correct errors between said actual position and a desired position ac- 
cording to the desired movement of said vehicle. 

In a preferred embodiment of the method according to the present inven- 
20 tion, the continuos cubic function is a Bezier function of a third power. 

In a preferred embodiment of the method according to the present inven- 
tion, the Bezier function is expressed in accordance with: 

x = ap 3 + bp 2 + cp + d 

y =ep 3 + fp 2 + gp + h, 
25 wherein a-h are constants, and p is a variable satisfying 0 < p < 1 . 

In a preferred embodiment of the method according to the present inven- 
tion, the method also comprises the steps of: 

to calculate said constants a-h according to the following expressions: 

a = X3 - 3x 2 + 3x! - x 0 
30 e = y 3 - 3y 2 + 3yi - y 0 

b = 3x 2 - 6x^ + 3xo 

f = 3y 2 - 6y<i + 3y 0 

c = 3x<i- 3xo 

g = 3yi - 3y 0 
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d = xo 
h = y 0 

wherein (xo, yo) is a start position and (X3, y 3 ) is an end position of said 
movement, and wherein (x 1? y-i) and (x 2 , y 2 ) are control positions of said move- 
5 ment. 

In a preferred embodiment of the method according to the method accord- 
ing to the present invention, the method also comprises the steps of: 

- to calculate an instantaneous center and angular velocity of said vehicle; 

and 

10 - to calculate speeds and angles of said drive units. 

In a preferred embodiment of the method according to the present inven- 
tion, the method also comprises the steps of: 

- if said error will result in abrupt movement of said vehicle, to integrate 
succeeding corrections; and 

15 - to add a suitable proportion of said correction for each time slice. 

In figure 5 there is disclosed a schematic diagram of some computer 
program products according to the present invention. There is disclosed n different 
digital computers 100i, 100 n , wherein n is an integer. There is also disclosed n 
different computer program products 102^ 102 n , here showed in the form of 
20 compact discs. The different computer program products 102!, 102 n are di- 
rectly loadable into the internal memory of the n different digital computers 10Ch, 

100 n . Each computer program product 102 1y 102 n comprises software code 
portions for performing some or all the steps of figure 4 when the product(s) 102i 
102 n is/are run on said computer(s) 100i 100 n . Said computer program 
25 products 102i, 102 n can e. g. be in the form of floppy disks, RAM disks, mag- 
netic tapes, opto magnetical disks or any other suitable products. 

One advantage with the present invention is that it can move a vehicle or 
robot along any predefined path, with a predefined change in rotation in accor- 
dance with a time scale. 
30 Another advantage is that it can move any number of vehicles synchro- 

nously, that is move several vehicles as though they were one, transparently to the 
user and without any mechanical connection or any cables between the vehicles. 

Another advantage is that it allows vehicle to be of any size while using 
the same set of components. 
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Another advantage with the present invention is that it allows the operator 
to control the speed of the movements dynamically, while the relation positions of 
all vehicles under his/her control remain the same. 

The invention is not limited to the embodiments described in the foregoing. 
It will be obvious that many different modifications are possible within the scope of 
the following claims. 



